臺達運動控制器10MC在音叉切割機上高階PID算法的應用
1 前言
晶振用一種能把電能和機械能相互轉(zhuǎn)化的晶體在共振的狀態(tài)下工作,以提供穩(wěn)定,精確的單頻振蕩。在通常工作條件下,普通的晶振頻率絕對精度可達百萬分之五十。高級的精度更高。有些晶振還可以由外加電壓在一定范圍內(nèi)調(diào)整頻率,稱為壓控振蕩器(VCO)。 晶振的作用是為系統(tǒng)提供基本的時鐘信號。通常一個系統(tǒng)共用一個晶振,便于各部分保持同步。有些通訊系統(tǒng)的基頻和射頻使用不同的晶振,而通過電子調(diào)整頻率的方法保持同步。
音叉多線切割機是用于替代多刀切割機加工晶振啟振音叉的設備。音叉多線切割機相對多刀切割機優(yōu)點:1、加工效率高10倍;2、耗材低;3、精度高,無需進行二次加工做研磨;4、經(jīng)濟效益高,一次可切割上千個音叉。由于普通指令無法滿足現(xiàn)場需求,因此只有通過簡單邏輯指令開發(fā)高階PID算法。
2 系統(tǒng)控制框圖及說明
設備框圖及工藝要求如圖1。
圖1 設備框圖及工藝要求
音叉多線切割是一種通過金屬絲的高速往復運動,把磨料帶入半導體加工區(qū)域進行研磨,將晶體一次同時切割為數(shù)千片薄片的一種新型切割加工方法。因此該套設備的難點是收放線軸與主軸高速同步保持不斷線,并且保證恒定張力。高速同步保證是通過收放線張力伺服編碼器反饋輸出值與給定值差,通過高階PID算法調(diào)整收放線軸速度,從而保證恒定張力。
3 配置方案選型及程序
該設備一共有八顆伺服,因此控制器選用臺達10MC總線運動控制器,如圖2所示。
圖2 臺達10MC總線運動控制器
DVP10MC11T是臺達自主研發(fā)的基于CANopen現(xiàn)場總線的多軸運動控制器,它遵循CANopen DS301基本通訊協(xié)議和DSP402運動控制協(xié)議,同時還支持大部分國際組織所定義的運動控制標準指令庫,極大方便使用者快速入門,迅速的進行項目開發(fā)。
DVP10MC11T 是一個多功能控制器,其內(nèi)部包含標準PLC 模塊和MC 運動控制模塊兩大功能模塊(如圖2)。PLC模塊與臺達其它DVP系列PLC功能相似,使用方法也相同,通過WPLSoft或ISPSoft 編程軟件,可以編寫梯形圖,順序功能圖,指令表等臺達標準的PLC 邏輯程序。PLC 模塊同時還支持左側(cè)和右側(cè)兩個擴展接口,左側(cè)為高速并行擴展口,可以連接最多7臺現(xiàn)場總線主站模塊(DeviceNet,CANopen主站等)、以太網(wǎng)模塊及高速模擬量模塊等,右側(cè)用來連接原DVP-S系列PLC的擴展模塊(如低速模擬量及數(shù)字量模塊)。MC運動控制模塊主要通過CANopen總線,對伺服驅(qū)動器進行精密的控制,以完成用戶所期望的速度控制、位置控制等功能。MC 運動控制模塊采用CANopenBuilder 軟件進行運動控制編程,來實現(xiàn)各種復雜的運動控制任務,運動控制語言以圖形化的方式提供用戶編寫運動控制功能,使用簡潔,易于學習理解。
10MC控制器是CANopen總線控制器,臺達A2-M伺服支持CANopen通訊。與10MC控制器配套選用。配線大大簡化、控制更加精確,能夠滿足高端設備的應用需求。
4 設置各個軸的軸參數(shù)
圖3 控制結(jié)構(gòu)圖
圖4 各軸伺服參數(shù)
5 數(shù)學模型建立
5.1 PID控制系統(tǒng)
連續(xù)一時間PID控制系統(tǒng)如圖所示。圖5中,D(s)為控制器。在PID控制系統(tǒng)中,D(s)完成PID控制規(guī)律,稱為PID控制器。PID控制器是一種線性控制器,用輸出量y(t)和給定量r(t)之間的誤差的時間函數(shù)e(t)=r(t)-y(t)。
圖5 PID控制
圖中的比例,積分,微分的線性組合,構(gòu)成控制量u(t)稱為比例(Proportional),積分(Integrating),微分(Differentiation)控制,簡稱PID控制。
5.2增量算法
當執(zhí)行機構(gòu)需要的不是控制量的絕對值,而是控制量的增量(例如去驅(qū)動步進電動機)時,需要用PID的“增量算法”。
圖6 PID增量控制
由位置算法求出:
兩式相減,得出控制量的增量算法式稱為增量式PID算法。
式中已看不出是PID的表達式了,也看不出P、I、D作用的直接關系,只表示了各次誤差量對控制作用的影響。從式中看出,數(shù)字增量式PID算法,只要貯存最近的三個誤差采樣e(k)、e(k-1)、e(k-2)就足夠了。程序如圖7、圖8。
圖7 程序圖
圖8 程序圖
3 離散化增量式PID算法的數(shù)據(jù)監(jiān)控
根據(jù)PID算法模型,高速運行時,收線放線伺服輸出偏差正負5轉(zhuǎn)以及張力擺動扭矩正負1牛。同時監(jiān)視主軸、張力、放線伺服的波形如圖9、圖10和圖11。
圖11 放線伺服的波形圖
通過監(jiān)視波形,在張力輪的角度發(fā)生偏差后,收放線速度能夠快速的進行改變,保持張力輪穩(wěn)定在一個相對固定的位置。由此可知,離散增量式PID算法在這種快速響應的控制系統(tǒng)中是可行的。
6 結(jié)束語
中達電通主要為中國最具成長潛力的通信及自動化市場提供設備和服務。其主要產(chǎn)品和服務包括視訊設備、動力系統(tǒng)、寬帶數(shù)據(jù)和機電自動化四個方面。中達電通的母公司為世界著名的電子制造跨國企業(yè)——臺達電子集團,臺達集團在江蘇吳江建有規(guī)模龐大的生產(chǎn)基地,是全球第一大電源管理系統(tǒng)供貨商和臺達變頻器、編碼器、人機界面、PLC、伺服、溫控器等機電產(chǎn)品的制造廠商。作為工控行業(yè)內(nèi)的知名廠商,尤其是在國內(nèi)唯一一家能將機電產(chǎn)品做的如此全面的制造廠家,我們通過應用自己的產(chǎn)品能夠為各行各業(yè)的客戶提供全面的解決方案。 最佳的產(chǎn)品性價比、周到完善的全國乃至全球聯(lián)保服務能夠保證客戶利益。中達電通的服務體系遍布全國。
經(jīng)過客戶各種崗位人員測試,此算法未出現(xiàn)任何沒有出現(xiàn)任何異常,滿足客戶各種操作要求以及傻瓜相機式的設計。
作者簡介:
應院祥,男,出生于1985年12月,畢業(yè)于江西現(xiàn)代學院電子與信息技術(shù)專業(yè),現(xiàn)任中達電通股份有限公司應用工程師。近幾年來一直從事運動控制產(chǎn)品的程序開發(fā)及營銷推廣等工作,具有5年的多線切割機開發(fā)經(jīng)驗以及各種機型工藝。
提交
追“光”而行 臺達邀您共赴上海光伏展之約
臺達“解密Cloud to Edge AI” 于COMPUTEX 2024展出驅(qū)動AI技術(shù)
臺達參編中國企業(yè)可持續(xù)發(fā)展報告指南6.0 助力高質(zhì)量ESG信息披露 共創(chuàng)低碳可持續(xù)未來
再獲嘉獎 臺達收獲“中國自動化產(chǎn)業(yè)年會”三大獎項
夯實智造升級基礎:設備聯(lián)網(wǎng) 信息通暢